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(g) Motion compensation apparatus and method for determining heading of a borehole. 

(67) A method and apparatus is disclosed for measuring motion signals of gyroscopes in dc>wnhole 
® ins^ments used to determine the heading of a borehole. An illustrative embodiment of the inverrtion 
includes a measuring-while-drilling system which may experience motion even while the dnH j *wg« 
suspended in rotary table slips when the heading of the drill string is being determined A^lerometer 
and magnetometer data along three orthogonal axes of a measurement sub »^ *«M unrt 
gravitational vectors § at a first time and at a second time and unrt magnetic vectors ft at the first time 
and the second time. The difference between the two unit gravitational vectors at the different times, Aft. 
and the difference between the two unit magnetic vectors at the different times, Aft, are used along with 

the unit vectors § and ft and the difference in time At to determine the rotation vector of the probe Q p 

which has occurred during such time difference. The vector representing the rotation of the earth, Q e 

is then determined by subtracting Q p from the vector Q 9 from three gyroscope instruments placed 
along the axes of the measurement sub. The heading of the drill string is determined from the 
gravitational vector and the earth rotation vector. 
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BACKGROUND OF THE INVENTION 

1. Field of the Invention 

5 This invention finds application in certain measurement systems which determine the heading of a bore- 

hole of a well. For example, the invention relates to measuring-while-drilling systems (MWD) which are de- 
signed to determine the position and heading of a tandemly connected sub near the drill bit of a drill string 
assembly in an oil or gas well borehole. The invention also finds application with wireline apparatus in which 
one or more down-hole instruments are designed to determine the position and heading of such instruments) 

10 during logging of an open hole borehole. In particular, the invention relates to the determination of the heading 
of the well from gyroscopic data regarding the earth's rotation and from accelerometer data regarding the 
earth's gravitational field. Still more particularly, the invention relates to an apparatus and method for com- 
pensating gyroscopic data for movement of a down-hole measurement instrument while a heading determi- 
nation is being made. 

15 

2. Description of the Prior Art 

Prior art measuring-while-drilling equipment has included magnetometers and accelerometers disposed 
on each of three orthogonal axes of a measurement sub of a drill string assembly. Such measurement sub 
20 has typically been part of a special drill collar placed a relatively short distance above a drilling bit The drilling 
bit bores the earth formation as the drill string is turned by a rotary table of a drilling rig at the surface. 

At periodic intervals, the drill string is stopped from turning so that the measurement sub in the well bore 
may generate magnetometer data regarding the earth's magnetic field and accelerometer data regarding the 
earth's gravitational field with respect to the orthogonal axes of the measurement sub. The h vector from the 
25 magnetometer data and the g vector from the accelerometer data are then used to determine the heading of 
the well. 

Such prior art method suffers from the fact that the earth's magnetic field varies with time and is affected 
by structures containing iron or magnetic ores in the vicinity of the measurement sub. Such variation leads to 
errors and uncertainty in the determination of the well heading. 

30 Such variation in the heading determination of the measurement sub of a MWD assembly, or a similar wire- 

line instrument, can theoretically be eliminated by adding gyroscopes to each of the orthogonal axes of the 
measurement sub. In theory, the heading of the measurement sub can then be determined from accelerometer 
data from each of such axes and gyroscopic data from each of such axes. The accelerometer data is responsive 
to the gravitational field of the earth, while the gyroscopic data is responsive to the rotational velocity of the 

35 earth with respect to inertia! space. 

Movement of the measurement sub (in the case of an MWD application) while accelerometer and gyro- 
scopic data is being taken can introduce an error into the determination of the earth's rotational velocity vector. 
Such movement may be caused by the "twist" or torque on the drill string after it is stopped from rotation and 
it is suspended from slips in the rig rotary table. Such twisting motion may occur on land rigs or on floating 

40 drilling rigs. Motion may also be produced while drilling has been suspended for a heading determination in a 
floating drilling rig where the heave of the sea causes the drill string to rise and fall in the borehole. Rotation 
of such drill string may be caused due to wave induced reciprocation of the measurement sub along a curved 
borehole. Analogous errors may occur in the case of a wireline instrument 

45 SUMMARY OF THE INVENTION 

A primary object of this invention is to provide an apparatus and method to compensate for rotation induced 
errors for an instrument which uses gyroscopic measurements for determining the heading of a borehole. 

An important object of this invention is to provide a specif ic application of the invention in an apparatus 
50 and method for compensating gyroscopic measurements of a MWD measurement sub for rotation of the meas- 
urement sub itself while accelerometer and gyroscopic measurements are being made. 

Another object of this invention is to provide a measurement apparatus and method for determining the 
direction of a well through the use of accelerometer and gyroscopic measurements where possible corrections 
for rotation of the apparatus are measured using accelerometer and magnetometer measurements. 
55 The objects identified above, along with other advantages and features of the invention are illustrated in 

a preferred embodiment in a method and apparatus for reducing a source of error in measuring-while-drilling 
(MWD) equipment. The invention is also intended for application in wireline instruments. In the MWD applica- 
tion of the invention, a measurement sub is provided having a separate accelerometer, magnetometer and gy- 

3 
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10 



roscope fixed along each of x, y and z axes of a sub coordinate system. An error is produced in gyroscope 
signals by the motion of the measurement sub in a drilling string while the string is suspended in a rotary table, 
during the time that a determination of the sub's heading with respect to the earth is conducted. A unit vector 
representing the earth's magnetic field with respect to the sub coordinate system is determined at a first time 

t, and again at a second time t 2 to produce unit vectors ^ti and ^t2 and a difference unit earth magnetic 
c 

field vector, A . A unit vector representing the earth's gravitational field with respect to the sub coordinate 
system is determined at the first time t, and again at the second time t 2 to produce unit vectors Sti and 9c 
and a difference unit earth's gravitational field vector. A 6 . The time difference At between t, and t 2 is also 
15 determined. From the vectors A fi . fi ti . A 9 . and the time difference At, a vector Q p representative of 

the angular rotation velocity of the measurement sub or "probe" is determined. Determination of Q " allows 

20 the gyroscopic vector measured during such time, Q 9 . to be corrected to determine the actual earth's rotational 

velocity vector Q e - Such vector and its components along with the accelerometer determination of the earth's 
gravitational field allow a determination of the heading or the direction of the well bore. 

25 BRIEF DESCRIPTION OF THE DRAWINGS 

The objects, advantages and features of the invention will become more apparent by reference to the draw- 
ings which are appended hereto and wherein like numerals indicate like elements and wherein an illustrative 
embodiment of the invention is shown, of which: 
30 Figure 1 is a schematic representation of a measuring-while-drilling system including a floating drill ship 

and a downhole measurement sub constructed in accordance with the invention; 

Figure 2A is a schematic representation of the downhole measurement sub with an accelerometer, mag- 
netometer and a gyroscope placed along orthogonal axes of the sub; and 

Figure 2B is a schematic representation of a micro-computer in the measurement sub with various com- 
35 puter programs to determine the heading of the sub while it is downhole using accelerometer data and gy- 

roscopic data where the gyroscopic data has been corrected for movement of the sub itself. 

DESCRIPTION OF THE INVENTION 

40 Figure 1 represents an illustrative embodiment of the invention for a MWD application. As mentioned 

above, the invention also may find application for a wireline measurement system. A drilling ship S which in- 
cludes a typical rotary drilling rig system 5 having subsurface apparatus for making measurements of formation 
characteristics while drilling. Although the invention is described for illustration in a MWD drilling ship envir- 
onment, the invention will find application in MWD systems for land drilling and with other types of offshore 

45 drilling. 

The downhole apparatus is suspended from a drill string 6 which is turned by a rotary table 4 on the drill 
ship. Such downhole apparatus includes a drill bit B and one or more drill collars such as the drill collar F il- 
lustrated with stabilizer blades in Figure 1. Such drill collars may be equipped with sensors for measuring re- 
sistivity, or porosity or other characteristics with electrical or nuclear or acoustic instruments. 

so The signals representing measurements of instruments of collars F (which may or may not include the 

illustrated stabilizer blades) are stored downhole. Such signals may be telemetered to the surface via conven- 
tional measuring-while-drilling telemetering apparatus and methods. For that purpose, a MWD telemetering 
sub T is provided with the downhole apparatus. It receives signals from instruments of collar F, and from meas- 
urement sub M described below, and telemeters them via the mud path of drill string 6 and ultimately to surface 

55 instrumentation 7 via a pressure sensor 21 in standpipe 15. 

Drilling rig system 5 includes a motor 2 which turns a kelly 3 by means of the rotary table 4. The drill string 
6 includes sections of drill pipe connected end-to-end to the kelly 3 and is turned thereby. The measurement 
sub or collar M of this invention, as well as other conventional collars F and other MWD tools, are attached to 
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the drill string 6. Such collars and tools form a bottom hole drilling assembly between the drill string 6 and the 
drill bit B. 

As the drill string 6 and the bottom hole assembly turn, the drill bit B bores the borehole 9 through earth 
formations 32. An annulus 10 is defined as the portion of the borehole 9 between the outside of the drill string 
5 6 including the bottom hole assembly and the earth formations 32. Such annulus is formed by tubular casing 
running from the ship to at least a top portion of the borehole through the sea bed. 

Drilling fluid or "mud" is forced by pump 11 from mud pit 13 via standpipe 15 and revolving injector head 
8 through the hollow center of kelly 3 and drill string 6, through the subs T, M and F to the bit B. The mud acts 
to lubricate drill bit B and to carry borehole cuttings upwardly to the surface via annulus 1 0. The mud is delivered 
10 to mud pit 13 where it is separated from borehole cuttings and the like, degassed, and returned for application 
again to the drill string. 

Measurement sub M, as illustrated in Figures 2A and 2B is provided to measure the position of the down- 
hole assembly in the borehole. Such borehole may be curved or inclined with respect to the vertical, especially 
in offshore wells. The sub M includes a structure to define x, y and z orthogonal axes. The z axis is coaxial 

15 with sub M. On each axis, a separate accelerometer, magnetometer and gyroscope is mounted. In other words, 
signals represented as G x . H x , ns x ; G y , H y , f>s y ; and G^ H z , Q* z are produced and applied to micro computer 
C disposed in sub M. Such signals are transformed to digital representations of the measurements of the in- 
struments for manipulation by computer C. 

The signals G x , Gy and G z represent accelerometer output signals oriented along the x, y, z axes of the 

20 sub M; H x , H y , and H 2 signals represent magnetometer signals; Q* x , na y , and Q 9 Z signals represent gyroscope 
signals. 

In operation, drilling Is stopped periodically, so that measurements of sub M can be performed to determine 
the heading 4> with respect to the vertical. In other words, a heading of <|>=0 means that the well is inclining or 
heading toward earth's geographic north. A heading of 4>=90° means that the well is inclining toward the east, 
25 and so on. 

The heading of the wellbore can be found using the tri-axial set of accelerometers G x , Gy, Gz and the tn- 
axial set of gyroscopes Oa x , 09 y . £28 z , to resolve the earth's gravitational field G and the earth's rotation vector 
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Q e into their components along three orthogonal axes. The rotation vector Q represents angular velocity 
of the earth with respect to inertial space. 

If the z axis of the measurement sub M is parallel to the axis of the wellbore, the direction of the borehole 

<}► can be determined from the vector components of 6 and Q as 



tan (+) = % "r* - \"/ (1) 



where 



9 if i 



is a unit gravitational vector with components gx, g y , g z 
and 



is a unit earth rotational vector with components © e x , © e y , o e z . 
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The term | | , or absolute value of the accelerometer vector Is defined as 

|G I = VG X 2 + Gy2 + 

The angular velocity vector Q 9 as measured by the gyroscopes is the sum of the angular velocity vector 
G e of the earth and the angular velocity vector Q p of the probe. In other words, 

Q Q « ~Q e + ~3 P 

When the drill string 6 is suspended in the rotary table 4 by slips and is not being rotated, the motion of 
the measurement sub M in the borehole can be a large source of error for the gyroscopes. Such motion may 
result from twisting of the drill string due to residual torsional energy of the drill string after it is stopped from 
turning. Such motion may also take the form of up and down motion of the drill string caused by the heave of 
the drill ship S. As a result, measurement sub M slides up and down along the curve of an inclined borehole 
during the time of the heading determination. In other words, the gyroscopic measurements are corrupted with 
measurements of the rotation of the sub M itself. 

This invention includes apparatus and a method for independently determining the rotation velocity vector 

-> 

G of the sub or "probe" relative to the earth, and then determining the earth's rotation vector Q° by sub- 
tracting Q p from the rotation vector Q° determined from the gyroscopes. 

The effect of the rotation of the measurement sub M relative to the earth on a unit vector fixed in the earth 
can be written as 

<J 0 = OxQ p (2) 
dt 

For finite time steps, equation (2) becomes 

AO = 0xQ p At (3) 

~* 

The vector Q p can be resolved into components parallel and perpendicular to 0 by forming the cross 
products of the left and right hand sides of equation (3) with 0 : 

AOxO = (QxQ p At)xu\ 



AOx 0 = Q p At - (0 -Q p At)0 
or 

Q p At = A 0x0 +(0 Q p At)0 (4) 

In equation (4), O p A t is expressed as the sum of two components. The component AG x 0 is perpen- 

6 



EP 0 646 696 A1 

dicularto 0 . The term ( 0 • G p At) Q p is parallel to 0 . 

Because the gravitational field vector 6 (obtained from G x , G y , Gz accelerometers) and the magnetic field 
5 -> . 

vector H (obtained from H Xf H y , H 2 magnetometers) are both fixed in the earth's frame of reference, two equa- 
tions can be written for Q p At 

Q p At = A§x§ + (Q - Q p At)§ (5) 

15 and 

Q p At = Afi x fi + (fi ■ Q p At)fi (6) 

where § and fi are unit vectors along the earth's gravitational field vector G and the earth magnetic field 
-> 

vector H f ■ * 

§ - j ■ where | G | = ✓ G x 2 + G y 2 + G 2 2 

30 

and 



20 



25 



3$ fi = j ^- ( ' where | H | = ✓ H x 2 + H y 2 + H z 2 

Equating the right hand sides of equations (5) and (6), the equation becomes, 

40 

x § + (9 • Q p At)§ = Afi X fi + (fi • Q p At)fi (7) 
-> 

45 Two equations for the unknowns ( 9 • G p At) and ( fi • Q p At), are obtained, for example, by forming the 

dot products of equation (7) with any two linearly independent vectors and ° : 

(A§ X §) • A + (§ • Q p At)§ A = (Afi X fi) • A + (fi • Q p At)fi "X (8) 
55 (A§ X 0) • B + (Q ■ Q p At)9 • B = (Afi X fi) ~B + (fi -QPAtjfi 1 (9) 
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Equations (8) and (9) can be put in matrix form and solved for ( § - Q p At) and ( - Q p At): 
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Q A -fi • A § -G p At (Afixfi) -A - (A§x§) 

§ • I -fi • Bj fi -Q p At J (Afi x fi) • B - (AQ x §) 

■ 

One possible solution of equation (8) and (9) is to choose 

A = Afixfi, 



(10) 



and 



B = x §. 

For such a selection, equation (8) can be solved directly for ( § • "At) and equation 9 solved directly 
for fi - Q P At. 

Figure 2B illustrates the microcomputer C which is disposed in measurement sub M. Several computer 
programs or sub-routines are stored in micro computer C to accept representation of signals from each of the 
accelerometers, magnetometers and gyroscopes. 

Computer program 30, labeled Magnetometer Computer program (unit vector), accepts magnetometer sig- 

nals H Xf H y and H 2 signals at times t t and t 2 as received from clock 32. The unit vector 11 is determined at 

each of times t t and t 2 . A representation of the unit vectors and is applied to computer program 36 
for further use. In the same way, the computer program or sub-routine 34 accepts signals G x , G y , Gz from ac- 
celerometers of measurement sub M. Computer program 34 determines unit gravitational field vectors at the 

times t t and t 2 . Such vectors ^ n and ^ are applied to program 36. 

The computer program 36 first determines the difference between sequential measurements of &i and 

and ^ti and . In other words, a representation of A d and A ^ is determined. The representation of 
At the time difference between the sequential measurement times, is also applied to computer program 36. 

Computer program 36 uses representations of A ^ , ^ , A ^ , ^ along with arbitrary vectors ^ and ^ 

( ^ and ^ selected to be linearly independent of one another) to produce a representation of ^At Either 

the 9ti , or the St2 or the mean value between such vectors may be used as ^ . Likewise, the or or 

50 the mean value between such vectors may be used as fi . The program 36 has a data input of At from clock 

-> 

32. Accordingly, the At representation is used with the representations of Q p At to produce representations of 
GP X * QP y , QP 2 which are applied to gyroscope correction computer program or sub-routine 38. Program 38 also 
accepts gyroscope signals fja x , ns y , na z . It then determines the difference of the probe rotation signals CV> X , 
55 HPy, Cl*> z from the gyroscope signals Q8 Xf Qa y , ns z to produce corrected earth rotation signals, a° xt Cl* y , & z for 
application to computer program or sub-routine 40 which produces the unit vector a a representative of the 
earth's rotation vector, that is, 
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^ = Q° . where | Q e | = s/ Q e2 x + Q e2 y + Q ft2 z . 



Next, the representation of the unit vector & e is combined with the representation of the unit vector A from 
program 34 to determine a corrected borehole heading 4 according to the relationship of equation (1) above. 
The signal <|> is applied to telemetry module T for transmission to surface instrumentation via the mud column 
10 of drill string 6 t standpipe 15 and pressure sensor 21 as illustrated in Figure 1. 

Practical aspects of the invention deserve mention. The gyroscopes used in this invention are preferably 
ring laser gyros. Fiber optic gyros or mechanical spinning mass gyroscopes may be used which are suitably 
protected to survive mechanical shocks of a downhole drilling environment 

a 

*5 The method outlined above does not take into account sources of uncertainty in the measurement of 

and fi- . Errors in the measured d and fi- time sequences can result in an inequality between the left and 
right hand sides of equation (7). Since equation (7) is a vector and must hold along any coordinate axis, it is 
in fact equivalent to three scalar equations. 

Since there are three equations and only two free parameters, the system of equations is over constrained. 
The method described above guarantees that the left and right hand sides of equation (7) will be equal in a 
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45 



plane containing the vectors A and B but they may not be equal on a line perpendicular to that plane as a 

result of errors in the measurement of § and fi. . The value of Q p obtained will depend on the choice of vectors 

-> 
A 

and B which has been made arbitrarily and without any consideration of which choice is "best". It is useful 
to determine the "best" estimate of the true rotational velocity of the probe given the uncertainties in the meas- 
urement of A § and A . 



Since A ^ and A .fi are both 3 dimensional vectors, a single measurement of A *9 andAfi canbeviewed 
as a single sample of a 6 dimensional random vector. The uncertainties in the measurements can be expressed 
35 in the form of a 6X6 covariance matrix, K, in which each element of the covariance matrix is the covariance 
between two of the components of the random vector. The covariance matrix can be determined by analyzing 

the sources of uncertainty in the measurement of A § and A ^ . Assuming that distribution of measurements 

40 of A 9 and A ^ obey a Gaussian distribution for multidimensional random variables, it is necessary find the 
value of Q p which maximizes the probability of obtaining the observed values of A Q and A fi . The maximum 

likelihood estimates of a § and A fi , A Smi and A fi mj . , are computed from the maximum likelihood estimate 



Q p 

of from the equations: 



50 A§ m , = (§ X Q» m ,) At 



55 



Afi ml = (fi X QP ml ) At 
The probability of observing the measured value of A 9 and A is proportional to the quantity: 
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exp 




9 • A§ ml 



\ 



Afi - Afi, 



ml / 
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To maximize the probability of observing the measured values of A 9 and A \ the factor in the exponential 
is minimized by treating the three components of O p as free parameters which are allowed to vary. The value 

~* Q p Q p 

of Q p so determined is the maximum likelihood estimate of * ml " 

Various modifications and alterations in the described methods and apparatus which do not depart from 
the spirit of the invention will be apparent to those skilled in the art of the foregoing description. For this reason, 
these changes are desired to be included in the appended claims. The appended claims recite the only limit- 
ation to the present invention. The descriptive manner which is employed for setting forth the embodiments 
should be interpreted as illustrative but not limitative. 



25 Claims 

1. Apparatus operatively arranged for measuring characteristics of a borehole comprising 

a measurement instrument operatively arranged for placement within said borehole, said instru- 
ment having a separate acceierometer and magnetometer fixed along each of z, x and y axes of an in- 
30 st rumen t coordinate system; 

computer means responsive to said magnetometers for determining a unit vector representing the 

earth's magnetic field with respect to said instrument coordinate system at a first time t 1t that is ^» , and 
at a later time t 2 , that is , and for determining a difference unit earth magnetic field vector, A fi , rep- 
resenting that difference between ^t2 and ^ti , and for storing a representation of A fi and fi ; 

computer means responsive to said accelerometers for determining a unit vector representing the 
earth's gravitational field with respect to said instrument coordinate system at said first time t 1f that is 

, and at a later time t 2 , that is 9t2 , and for determining a difference unit earth gravitational field vector, 



35 
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45 



A * , representing the difference between ^ and ^ n , and for storing a representation of A 9 and 

a ; 

means for generating a representation of the difference in time At between said first time U and 
said second time t 2 ; and 

50 computer program means responsive to said representations of A , , A , 9 and At for deter- 

mining a vector ^ P representative of the angular rotation velocity of said instrument 

2. The apparatus of claim 1 wherein said instrument is a measurement sub operatively arranged for tandem 
55 connection to a drill string. 

3. The apparatus of claim 2, wherein said instrument has a separate gyroscope fixed along each of said 
axes, and further comprises: 

10 
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computer means responsive to said gyroscopes for determining a vector Q 9 representative of 
the rotational velocity of the earth and the rotational velocity of said measurement sub and for storing a 

representation of said vector Q 9 ; and 

computer means for producing a vector representative of the earth's rotational velocity M with 

respect to said sub coordinate system by subtracting said vector from said vector Q g 

The apparatus of claim 1, wherein said computer program means for determining a vector ^ P includes 
means for solving the equation 



AS X § + (§ • Q p At)§ » Afi X fi + (fi - Q p At)fi. 

In apparatus operatively arranged for measuring characteristics of a borehole, said apparatus including 
an instrument having a separate accelerometer and magnetometer fixed along each of z t x and y axes 
of its coordinate system, a method for determining the angular rotation velocity of the instrument when 
placed within the borehole comprising the steps of: 

determining from signals of said magnetometers a unit vector representing the earth's magnetic 



field with respect to said instrument coordinate system at a first time t t , that is, , and a later time t 2f 
that is, ^t2 ; 

determining a difference unit earth magnetic field vector, A fi , representing the difference between 
fi t2 and An ; 

determining from signals of said accelerometers a unit vector representing the earth's gravitational 
field with respect to said instrument coordinate system at said first time t 1( that is and at a later time 
t 2 . that is ^ ; 

determining a difference unit earth gravitational field vector, A § , representing the difference be- 
tween ^ , and ; and 

determining from representations of A fi- , fi- , A 9 ,9 and At a vector Q p representative of 
the angular rotation velocity of said instrument. 

The method of claim 5,wherein said instrument is a measurement sub tandemly connected to a drill string. 

The method of claim 5, for use when said instrument has a separate gyroscope fixed along each of said 
axes, further comprising steps to determine the earth's rotational velocity with respect to said sub coor- 
dinate system, such steps including: 

-> 

determining from signals of said gyroscopes a vector representative of the rotational velocity 
of the earth and the rotational velocity of said measurement sub; and 

determining a vector representation solely of the earth's rotational velocity vector with respect 

Q p ofe 
to said sub coordinate system by subtracting said vector from said vector w . 

11 
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QP 

8. The method of claim 5, wherein said step of determining a vector includes the step of solving the equa- 
tion 



A§ X Q + (§ • Q p At)Q = Afi X fi + (fi • Q p At)fi. 
10 9. The method of claim 8 further comprising the step of computing the maximum likelihood estimate of 



15 QP 

1 0. The method of claim 9 f wherein the step of computing the maximum likelihood estimate of includes 

the step of minimizing the quantity 



1 



20 



25 



where 



and 



AlL = (g X QP ml)At, 



30 



35 



Ah ml = (h X DP ml )At, 

by treating the three components of qp as free parameters which are allowed to vary, with the value of 
so determined being the maximum likelihood estimate of 
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FIG. 2 A 
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